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Peer nOmuCc. LON 


Passive localization and tracking techniques are of 
interest in a variety of microcomputer based surface/ 
subsurface radar applications. 

Because a Significant portion of the cost of building 
or maintaining a warship is the electronics in its sensor 
and weapon system, and because a great amount of time and 
manpower is employed in performing simple but important 
tasks, microcomputers offer the potential to: 

(1) Reduce the cost of digital systems, 

(2) Perform some complex functions at remote stations, 
relieving the congestion at larger central computer 
facilities, and 

(3) Perform functions currently handled by watch personnel, 
thus reducing the manning requirements of watch 
sections. 

An example of this is the problem of manual tracking of radar 
contacts and the solution of Maneuvering Board Problems. 

It is the purpose of this study to demonstrate than an 
alternate approach to the solution of the problems mentioned 
above can be developed and implemented by using a micro- 
computer system, while at the same time maintaining a human 


engineered user interface. 
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II. FORMULATION OF THE PROBLEM 


A. PREFACE 

For Naval ships not equipped with Naval Tactical Data 
Systems (NTDS), Operations performed by the Combat Infor- 
mation Center (CIC) during a normal peacetime watch include 
manual tracking of radar contacts and solution of maneuvering 
board problems. The environment emulated by the Intel 
Intellec Microcomputer Development System (MDS) provides a 
data subset of the NTDS. The subset of information is 
provided via radar interface to the MDS System. 

The interface between the microcomputer and the surface 
radar was not constructed to due cost, time and manpower 
constraints. 

The scenario of the study was limited to the development 
of a Kalman Filter bearing-only tracking algorithm for the 
Intel Intellec MDS microcomputer system and Intel SBC-310 
High-Speed Mathematics Unit Performance. Simulation of the 
circuitry is necessary to interface with the AN/SPS-10 
surface search radar. 

The parameters for the AN/SPS-10 surface search radar 
were used for computations requiring specific radar 
parameters. This radar was chosen because all information 
regarding the radar is available at the Naval Postgraduate 


Benool. 
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A Kalman filter was selected because it minimizes the 
estimation error in a well defined statistical sense and 
most complex calculations of the tracking Bicers ey eeowily 
used for bearing-only radar tracking that is easily 
computable with a microcomputer system. 

The system input/output parameters are shown in 


muoure 1. 


B. TYPICAL COMBAT INFORMATION CENTER OPERATIONS 

During normal peacetime steaming, the CIC watch team 
may consist of from two to ten or even more personnel, 
depending on the size of the ship as well as on the complexity 
of the equipment being used. 

Among the problems that are normally solved by CIC 
personnel, special mention needs to be made of those of 
plotting contacts and the determination of parameters such as 
course, speed and closest point of approach (CPA) of those 
Beneaccs. This isatedious and error-prone task; it often 
requires most of the time and effort of the CIC team and it 
iemvitally important to the safety of the ship. This had 
ted to the installation of equipment to reduce the amount 
of workload in the CIC while at the same time improving the 
Betiability of the constant information provided to the 
bridge. This equipment includes dead reckoning devices and 
meZ plotter. 

1. Maneuvering Board Plotting Sheets 

The maneuvering Board Plotting Sheets (H.O. 2665-10) 
have been prepared in order to facilitate the solution of 


a ship's relative movement problem. 





Contact 


FROM ; 
AN/SPS-10 Bear ing Expected Contact Course 
RADAR Contact 

Range Pxpected Contact Speed 
an Course expected Contact Range 
PITOMETER Own Ship 
LOG peed Expected Contact Bearing 


Time 


cs OS eA 


Eigueemie SYSteM INPUT/OULPUT PARAMETERS 
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The primary responsibility of CIC is to provide 
information and recommendations on the tactical situations, 
such as contact course, speed, CPA information, are defined 
using the "Maneuvering Board" plotting sheets. But the use 
of the Maneuvering Board requires some pracice, also it 
requires the complete attention of one person during the 
mac Operation. 

2. Dead-Reckoning Equipment 

This equipment maintains a continuous, up to the 
Minute, geographic plot of own ship's plot in the CIC. 

The Dead-Reckoning System consists of the following 
basic components: (1) Dead-Reckoning Analyzer (DRA); 

(2) Dead-Reckoning Indicator (DRI); and (3) Dead-Reckoning 
Time (DRT). Course and speed inputs of own ship are fed 
into the DRA from Gyrocompass and pitometer-log and then to 
the DRT, where they cause a movable source of light to trace 
the ship-track continuously. 

In all systems as mentioned above the target's rela- 
tive position measurements are obtained from radar repeater 
and plotted on the systems which are read to be used. The 
range measurement accuracy is at best + 20 yards and 
bearing measurement accuracy is + 1 degrees with a well 
calibrated repeater and a well trained operator. The own 
ship speed and course are used to determine the own ship's 
velocity vector. The course and speed of own ship may vary 


+ 1 degree and + 1 knot depending on the helmsman, weather 
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conditions and the ship instruction. The combined result 
and the manual solution will cause + 5 degrees in course 
and + 3 knots in speed of the target information. Also 
the major disadvantage of the manual solution, in addition 
to itS poor accuracy, is the time required to obtain the 
solution and the inability to obtain solutions of either 
the target or own ship maneuvers between radar position 


measurements, typically 3 or more minutes apart. 


C. MICROPROCESSOR TECHNOLOGY 

Recent advances in large scale integration (LSI) semi- 
conductor process technology have made possible substantial 
reductions in the cost and size of digital logic circuits. 
Microprocessors represent a very remarkable achievement 
of engineering ingenuity and industrial know-how at their 
pest. 

Since 1973, the year in which Intel Corporation shipped 
the first 8080, 8-bit N-channel microprocessor, a number of 
manufacturers have developed similar products and because 
of this competition prices have been drastically lowered. 
With hardware and software system development costs as they 
are, much micro work is done on a custom basis. The primary 
advantage of microcomputer based systems is to have 
specialized and dedicated equipment solving specific 
problems. 

The microprocessor families are: (1) 4-bit machine; 


(2) 8-bit machine; (3) 16-bit machine; and (4) bit-slices 
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architecture. 16-bit microprocessor is the best solution 
for our concern of tracking problem. But Intel's 8080 was 
selected as an 8-bit microprocessor and programmed for 
double precision arithmetic to perform Kalman Filter 
algorithms, because of its lower cost and availability at 
the Naval Postgraduate School with all its hardware and 


software support devices. 


D. SCENARIO 

In order for a ship to maintain operational readiness 
as a unit of a task force, it must be aware of the current 
operational environment. The operational environment is 
defined as the surface/subsurface contact profiles in the 
geographic area of interest. The contact profile consists 
of friendly, hostile, and unknown contacts with associative 
contact characteristics. Contact characteristics are such 
measurements from radar, range and bearing to accurately 
determine the course and speed of a radar contact. If the 
radar measurements were perfectly accurate and the target 
had zero acceleration, then the tracking problem would be 
velocity vector problem as shown in Figure 2, velocity 
vector and contact relative motion plot as shown in Figure 3. 
But the radar bearing and range measurements on any scan have 
errors which are a function of the radar system and the 
received signal to noise ratio. The measurement errors will 


be discussed after defining the Kalman Filter parameters. 
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Figure 2. GEOGRAPHIC PLOT OF CONTACT AND OWN SHIP MOTION 
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The contact motion on a X,Y coordinate system can be 
approximated by linear dynamic system. The target dynamics 
can be represented in a matrix form as shown below to define 
the sample data system such as a search radar where the 
measurements are taken once each antenna rotation 


(Reference 13) 


ete n n 
where: 
2 
x te  O 0 eam 2 0 
x a 9 @ et ay 0 
on q : an : i 2 
ven po ly 0 TAZ 
ZA UF Onre0 vl 0 il 
and, 
Z = vehicle state vectorat scan n, 
ae = E/W position of the vehicle, 
Bo = E/W velocity of the vehicle, 
i = N/S position of the vehicle, 
2 = N/S velocity of the vehicle, 
T = interval between observations, 
2 acceleration acting upon the vehicle from 


scan (n) to (n+l). 
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A Kalman filter is a common optimal filtering technique 
for estimating the state of a linear system. It is selected 
to implement the tracking problem because it is computa- 
tionally the most demanding technique in our concern. The 


details of the Kalman filter will be analyzed in Chapter IV. 
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III. SYSTEM DESIGN CONSIDERATIONS 


A. HARDWARE DESIGN CONSIDERATIONS 

Microprocessors, in general, are not complete computers, 
but Central Processor Units (CPU) implemented with one to 
ten large-scale integrated-circuit chips. Large-scale 
integration (LSI) chips are comprised of 1,000 or more 
gates; many LSI chips hold over 6,000 gates ora "complete 
central processor." 

The word "micro-computer" refers to a small stored 
program computer comprising memory and input/output circuits 
megether with a microprocessor CPU. 

Interface design and programming make the mass-produced 
microcomputers into new special-purpose dedicated machines. 

The Intellec Microcomputer Development System (MDS) is 
a complete, coordinated computer system designed around 
Intel's 8080 microprocessor. The MDS has a 2 microsecond 
instruction cycle, a repertoire of 72 powerful instructions, 
unlimited subroutine nesting, and a versatile interrupt 
scheme. 

The MDS was selected because of its 8080 microprocessor, 
its memory capabilities, its interrupt mechanism, and its 
extended I/O capabilities. Also, the selection of the 
Intel Microcomputer Development System (MDS) was made for 
this theis because of its immediate availability at the 


Naval Postgraduate School. 
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A Datamedia Elite 2500 Video Terminal was chosen to 
present alphanumeric information because its features 
include: (1) Editing and roll operation modes; (2) 50 to 
3600 baud programmable speed transmission; (3) protected 
fields, (4) computer derived or high light field (blink); 

(5) addressable cursor. 

Because of the computation of Kalman filter algorithms, 
floating-point calculation required, an SBC-310 high-speed 
math unit, developed by Intel Corporation, was incorporated. 
In performing high speed mathematical functions, the Math 
Unit acts as an intelligent processor, performing a reper- 
toire of 14 arithmetic functions and at least an oder of 
magnitude faster than comparable software routines. Why 
it is to selected to perform the algorithms will be discussed 
in Section C of this Chapter, and Figure 4 shows the final 
configuration of the equipment used in developing this 
thesis. Also, start-up procedures for the system were listed 


in Appendix B. 


fe SOFTWARE DESIGN CONSIDERATIONS 
1. Language Selection 
Choice of the computer Langwece to be used was 
partially dependent upon the hardware configuration. 
PL/M-80 was preferred as a programming language to be used, 
after selecting MDS hardware system, to the assembly language 
because of its ease as programming and immediate availability. 
PL/M-80 is a high level language developed by Intel 


Corporation and esigned especially for system and applications 
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Figure 4. EQUIPMENT CONFIGURATION 


programming for the Intel 8080 microprocessor. It isa 
block structured language which speeds the microprocessor 
program development by relieving the programmer of the 
tedious task of memory and register management. 

ISIS-II disk operating system also developed by Intel 
Berporation for the Intellec MDS system has a resident 


PL/M-80 compiler which has been very useful during the 
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implementation, debugging and testing the program. The 
PL/M-80 compiler accepts the statements as input and produces 
a machine-code program module as output. 
PL/M statements are divided into two basic categories: 
1. DECLARE and PROCEDURE statements. 
2. EXECUTABLE statements, which are all other than declare 
and procedure statements. 
EXECUTABLE statements cause machine code to be generated. 
DECLARE statements cause variables to be defined associated 
with objects and PROCEDURE capability permits program to 
be constructed in a modular fashion, which has numerous 
advantages including efficiency of coding, readability of 
programs, ease of debugging and possibility of using the 
same procedure in more than one program (Ref. 6). 
2. Floating Point Arithmetic 

Floating point arithmetic is required because range 
of numbers to be represented is large and sometimes unpre- 
dictable, especially in the Kalman filter algorithm. In 
this algorithm when the time concern to use a floating point 
arithmetic is disadvantageous, because it needs additional 
subroutines or hardware, but when the accuracy concern we 
must use it in our programming. 

In selecting floating-point formats, the primary 
considerations are word size and the radix of the arithmetic. 
In much of the literature, 24-bit word size is regarded as 
too small for scientific computation. The Intel standard 


for floating point arithmetic has been adopted to apply to 
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all general purpose products including software systems, 
and components. Such as FPAL (Floating-Point arithmetic 
library) for the 8080 and Math Board (SBC-310) made of series 
3000 bit slices have already been produced using this 
standard. 
As the floating-point arithmetic formats concern 
there are two standard formats which have been accepted 
meom intel (Ref. 12): (a) 32-bit short precision word; 
(b) 62-bit long precision word. The 32-bit short precision 
word format with binary radix was chosen because of the hard- 
ware consideration by selectin the MDS system and 8080 
microprocessor with SBC-310 high speed mathematics unit was 
the fastest and available at the Naval Postgraduate School. 
Comparison will be done next with its compatibles: 


(1) AM9511 Arithmetic processing unit (Advanced 
Micro Devices, Inc.) 


(2) 8080/8085 Floating-Point Arithmetic Library (FPAL) 
(Intel Corporation) 


my 24-bit special floating point (Ref. 11) 


(4) SBC 310 High Speed Mathematic Unit (Intel 
ZOrPOrAtION) . 


a. AM9511 Arithmetic Processing Unit 
The AM951l1 is a monolithic MOS/LSI device which 
provides high speed, 16 and 32 bit fixed and 32 bit floating- 
point arithmetic, plus a group of transcendental derived 
functions, control and conversion commands. 
The AM951l APU is contained within a single 


dual-in-line 24 pin chip as described in detail in Ref. 3. 
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The distinctive characteristics of the AM95l1l 
APU include: 
- Fixed-point 16 and 32 bit operation 
- Floating-point 32 bit operation 
- Binary data formats 
- Basic add, subtract, multiply and divide 
- Trigonometric sine, cosine, tangent 
- Inverse trigonometric arcsine, arccosine, arctangent 
mee coguare roots 
- Logarithms base on 10 and e 
- Exponentiation 
- Float-to-fixed and fixed-to-float conversions 
- stack oriented operand storage 
- DMA or programmed I/O data transfers 
- General purpose 8-bit data interface. 
Data Formats: 

All fixed-point operands and results are 
represented as binary two's complement integer values. The 
16 bit format can express numbers with a range of -32,768 
to +32,767. The 32 bit format can express numbers with a 
range of -2,147,483,648 to +2,147,483,647. 

The floating point format uses a 32 bit word 
width as shown in Figure 5. The most significant bit (bit 31) 
indicates the sign of mantissa. The next seven bits form 


the exponent and remaining 24 bits form the mantissa value. 
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Figure 5, FLOATING-POINT FORMAT FOR AM9511 APU 


The exponent of the base 2 is an unbiased two's 
complement number with a range of -64 to +63. The mantissa 
is a sign-magnitude number with an assumed binary point 
just to the left of the most significant mantissa bit (bit 2). 
All floating point values must be normalized which makes 
bit 23 always equal to 1 except when representing a value of 
zero. The number zero is represented with binary zeros in 
meee 32 bit positions. 

The operation of the APU is described in Ref. 3 
in detail with the command formats and their descriptions. 
The AM9511 interested commands, its clock cycles and 
typical execution times for three different clock frequencies 


such as 2 MHz, 3 MHz and 4 MHz are shown in Table I. 
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Table I. 


AM9511 ARITHMETIC PROCESSING UNIT COMMAND 
EAECULION TIMES 





TYPICAL EXECUTION TIMES 
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Table 1 (Continuation). AM9511 ARITHMETIC PROCESSING 
UNIT COMMAND EXECUTION TIMES 
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b. 8080/8085 Floating-Point Arithmetic Library (FPAL) 
The FPAL procedures reside in object code module 

Beem in the library "FPAL.LIB”" on the Intellec ISIS-II 
System diskette. They are self contained and can be used 
in component, OEM—board, or Intellec Microcomputer, Develop- 
ment System. It contains basic floating point subroutines 
and functions (referred to generally as "procedures"). 
The operations provided are: 

= Addition, subtraction, multiplication, division 

- Value comparison 


- Conversion between decimal and binary floating point 
and 32 bit signed integer formats 


- A default error handler subroutine. 
For all operations single precision format is used and in 
addition to these operations, a number of procedures are 
provided to deal with the Floating Point Record (FPR). This 
1s a reserved, 18 byte work area used to collect status and 
error information, and as an accumulator for intermediate 
results. The procedures supporting the FPR perform FPR 
initialization, change error recovery options, check the 
contents of FPR fields, and pass numbers between the FPR 
and memory. 

. The FPAL also includes a default error-handler 
Subroutine. This subroutine is called when an invalid number 
is used in a floating-point operation or if overflow, 
underflow, or division by zero are not handled by an 


arithmetic subroutine. We may also write our own error 
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handler, so long as it conforms to the formats described 
in Reference 2. 

The FPAL can be used by assembly langugages or 
PL/M programs. 

In general, the following steps must be observed 
to use the Floating-Point Library: 

1) An area of memory must be reserved for the Floating- 
Roane Record (FPR). 

(2) The names of the FPAL procedures must be declared to 
be "external". 

(3) FPAL procedure references must be imbedded in our 
source code where appropriate. 

(4) The FPAL procedure used by our program must be linked 
to our object file. | 

(5) If we want to use the FPAL procedures in our program, 
that program cannot use symbols that are reserved for 
FPAL such as symbolic names beginning with a 
Becmmercial at" Sign, "@" or names whose second 
mheracter 1S "O" or "2", 

Floating Point Record (FPR) procedures, 
arithmetic procedures, error handling procedures, and inter- 
face to FPAL are described in Reference 2 in detail. 
maca Formats: 

FPAL procedures operate on single-precision 
binary numbers, either 32-bit integer format or ina 32-bit 


Floating-point format. 
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The integer format recognized by the FPAL is a 
positive or negative (two's complement) 32-bit binary number 
The approximate range of this format is from ~2.147x107 to 
+2.147x10°". Single-precision formats in the floating-point 


accumulator and 8080 memory areas are shown in Figure 6. 


a 


where s = sign bit 


4) 
ll 


exponent 


Kh 
tl 


fraction or mantissa 


Figure 6. SINGLE PRECISION FORMAT FOR FPAL 


The three fields within these formats are: 

5. (ee is the sign bit. Sign magnitude repre- 
sentation wehre s = 0 means positive and 
s = 1 means negative. 

E........1s exponent bits. The exponent is offset by 
Ose All zeros and all ones in the 
exponent field are currently reserved for the 
floating point zero and the invalid numbers 


described above. 


a2 





° eee is fraction bits. When the exponent is nonzero, 
a l bit is assumed at the left of the fraction; 
the binary point 1S between the assumed bit 


and the explicit fraction bit. 


The number base for the FPAL is binary. The 
value of a given binary representation can be formulated as 


S ye- (27-1) 


(in) leet.) 


where e # 0 and e # FF. 


When overflow or underflow occurs during FPAL 
operations, the correct fraction results but the exponent 
is "wrapped around". A "wrapped around" exponent is defined 
Ee be eur where the true (offset) exponent, e,, can be 
derived from Qe. by considering an expanded range of 


exponents and 


on overflow 


@ 
Il 
@ 
l 
WJ 
NO 
t 
NO 


on underflow e 


Il 
(D 
I 
~~ 
LJ 
NO 
l 
NO 
ae 


The floating point arithmetic library (FPAL) complete 


functions and execution times are given in Table 2. 


ee 





Typical 
FPAL Procedure Execution 


Float.-Point Add. (FADD) 


Float.-Point Multiply (FMUL) oe 1500 
Float.-Point Divide (FDIV) 3600 
Conversion from decimal float.-point . ; 
Raber ts binay orbs a 
Conversion fran binary float.-point 

mumber to decimal (FOFB2D) = 


Plost-to-rined cnversin reo) | 178 [mot given 
Fixed-to-Float Conversion (FLTDS) | 239 prot given 


Note: All time values are specified in 
microseconds. 





Table 2. 8080/8085 FPAL FUNCTIONS AND EXECUTION 
ES 
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c. 24-Bit Special Floating-Point Arithmetic 
Software Subroutines 


This software subroutine has been written in 
Reference 1l to perform the floating-point arithmetic. But 
the format that has been used is not our concern and not 
suitable to our standards. The only reason it was mentioned 
here is to show how slow execution times it has even with 
16-bit mantissa. Its functions and execution times are 
given in Table 3. 
dad. The SBC 310 High-Speed Mathematics Unit 
The SBC 310 High-Speed Mathematics Unit is a 
member of a complete line of Intel SBC 80 system expansion 
modules. In performing high-speed mathematic functions, 
the Math Unit acts as an intelligent processor slaved to 
one or more SBC 80 computer masters. The math unit performs 
its repertoire of 14 arithmetic functions an order of 
magnitude faster than is possible with software routines. 
Its functions and execution times are shown 
in Table 4 and a detailed description of programming infor- 
mation and principles of operation are explained in 
Appendix A because it was selected to perform this thesis. 
Four different systems and their features have 
been explained individually as they're chosen to be 
compared in the beginning of this section. The comparison 
among the SBC 310, High-Speed Math Unit, the AM9511 


Arithmetic Processing Unit, the Floating-Point Arithmetic 


535) 





OPERATION NAME MAX EXECUTION TIME 





Sp 


24-bit Floating-Point Addition 


24-Bit Floating-Point Division 


(DIV) 4100 


(ADD) NSEC 

24-Bit Floating-Point Subtraction 1400 
(SUB) 

24-Bit Floating-Point 

Maltiplication 3400 
(MULT) 


Floating-Point Comparison 800 
(COMPARE) 


Floating-Point Squareroot 
(SQRT) 


17,000 





24-Bit Floating-Point Cosine 

(TRIG Iy) eS 
24-Bit Floating-Point Sine 

(TRIG 2) 18, 000 


24-Bit Floating-Point Cos and Sine 
(TRIG 3) 


30,000 









Floating-Point Arctangent 


(TRIG 4) ILEA ovale 







All time values are specified in microseconds. 





Table 3. 24-BIT SPECIAL FLOATING-POINT ARITHMETIC 
OPERATIONS NAME AND EXECUTION TIMES 
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OPERATION] TYPICAL 





MAXIMUM 
/ EXECUTION 


TIME 
Se a 
a 
Float.-Point Add (FADD) Pies |= | 
a 
Float.-Point Square Root (FSQRT) 
a 
ae 
panne [pa [7 


Sk 


Note: All time values are specified in microseconds. 


QPERATION NAME 


Listed times do not include time to pass arguments to the 
MATH UNIT and to read results upon campletion; this is 


typically 20 microseconds. 





Table 4. SBC-310 HIGH SPEED MATH UNIT FUNCTIONS AND 
ESSCcuLlton TIMES 
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Library (FPAL), and 24-bit Special Floating-Point Software 

execution times of their operations are shown in Table 5. 
The AM951l1 APU has the fastest and SBC-310 High 

Speed Math Unit has the second fastest execution times. 

Also, if we compare the cost of the units, the AM9511 is 

Only $195 in the market and it 1s cheaper than SBC-310 

Math Unit. But, when the purpose of this thesis concern, 

as a Kalman Filter, and immediate availability at the 

Naval Postgraduate School, the SBC 310 High-Speed Math Unit 

was chosen to perform the arithmetics of the Surface/ 


Subsurface Bearing-Only Tracking Radar algorithms. 


See PHILOSOPHY OF SOFTWARE DESIGN 
The system was designed with the following objectives: 
1) Human engineered user interface. 
2) Capability of solving maneuvering board problems 
using Kalman Filter algorithms. 
3) Capability to display the result and the error 
performance of the assumed problem definition. 

In order to avhieve these objectives, the following 
modules were developed: 

a) "INTSDATA": This module contains range and bearing 
information of selected contacts and their observation time 
intervals for each scan. 

er. "MAINSPROG": This module is used to perform the 
implementation of Kalman filter algorithms, results and 


error calculations. 
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SYSTEM TYPICAL EXECUTION TIMES 








32-bit Fixed Point Operations 


ee he ee 
a 


32-bit Floating Point Operations 





Float-to-Fixed 


Conversion 
Conversion [hee 


COSINE 3800 1920 ac 18,000 


Note: All time values are specified in microseconds. 





Table 5. COMPARISON OF FOUR DIFFERENT SYSTEMS EXECUTION 
TIME OF OPERATION 


So 





cc. "DISPLAY": This is used to display the result 
mma error calculations on the CRT. 

ad. "FLOATINGSPOINT": This module is used to perform 
all the necessary floating-point operations and to calculate 
the cosine and/or sine of a given angle in radians and the 
arctangent of the ratio of two input parameters. 

The whole program is listed in Appendix E. The formats, 
units and conversion factors used in the program are shown 
in Table 6. The Kalman filter will be described in 


Chapter IV. 
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FORMAT UNITS 
$$$ mnrernaL | 1/0 __| INTERNAL 


COURSE XXX. KK «Pes degrees radians 






n.mile/ 
sec. 





SPEED XXXX.XX .P. knots 








BEARING XXXX.XX radians 





nautical 
miles 








RANGE XOUKX KX 







~ Ae Numeric Character 


Floating Point Represen-ation 







me mevitacakbemile .s¢ge65. 2025.3716 yards 





SA, 0.0174532925 radians 







Re ge ce ee ce 6st lL nautical mile/hour 


,oo oS SS AS oeenenas eS oe 593 






Mable 6. FORMAT, UNIT AND CONVERSION FACTORS USED 
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IV. KALMAN FILTER 


A two dimensional Kalman tracking filter provides a 
convenient framework for determining optimal filter 
parameters for x,y tracking for a two-dimensional radar 


measuring range Rand bearing 98. 


me. DISCRETE KALMAN FILTER ALGORITHM 
The vehicle dynamics can be represented in matrix form 


as stated earlier. 


Z = © 7 + Ta (Ref. 13) 


where Ze ¢, © and a, were defined in Chapter II. 

The discrete form of a Kalman filter rather than 
continuous form 1S appropriate because of surface search 
radar antenna rotation results in scan while measurements 
@ewtme Contact position. The matrix form of the observation 


equation can be written as 


ve = HZ, + Ue (Ref. 13) 
where 
x, (7) 
oa 
Yn (7) 
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measured x coordinate at scan n 


x(n) 


Yn 6) measured y coordinate at scan n 


ae = Vehicle state vector at scan n 


v,, (n) random noise On X measurement at scan on, x, (n) 


a7) = random noise on y measurement at scan n, Y,, (7) - 


Optimal estimates of the contact state vector at 


a 


wean n, Z, are given by 
Z = Z + Kw, - HZ ) (Reference 13) 


where 


Zo is the estimated state vector at scan n, 


¢ (see Chapter II, Section D) 
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Z = Optimal estimate of target state vector at scan (n-1) 


and 


x x 
n ig 
a v7 
8 x Es 2s 
Z = A " av Z = me 
n Nn y 
Yn n 
Yn Yn 


Z is the optimum estimate of the state vector after the 


measurement Wa is processed 


Z is the optimum estimate of the state vector before 


the measurement we 1s processed 


Tk 1 


K - P H? (HP Heo RR) (Reference 13) 
n 1é n 


K is the gain matrix at scan n and computed for steady- 


state as 
A A 
xX XY 
Kn = Bay/T Byy/T 

A A 
yx YY 

B Ay B fy 
yx’ yy’ 
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P is the estimated covariance matrix of the estimation 
errors prior to the processing run. 


R is the covariance matrix for the observation noise. 


2 De 
een) sr 
Rn = | 
2 2 
ora VEY ae 


where using the polar coordinate system shown in Figure 7. 


x = R sin 80 

m 

ee Re Gos 9 
y (NORTH) 


R (Range) 
6 (Bearing) 


(WEST) — (EAST) 
(SOUTH) 


Figure 7. COORDINATE SYSTEM 


45 





iimewelemenctcs OF the covariance matrix for observation 


noise are: 


2 - 2 aeeZ 2 a 
oe (n) = o. sin 6+ R (n) cos’ 6¢n) O . 
2 2 2 2 , 2 
ss (n) = 6, cos ty eetenerGny Sim. 9 (ni) o 
(n) = = sin 286(n) [o —_ Rr) 1G. eal 
ay 2 8 
0 = variance of the range measurement noise 
a = variance of the bearing measurement. 


R(n) and 6(n) are the vehicle range and bearing at scan n. 


The covariance matrix P, can be computed recursively as 
= 6 P_ 6 + Or (Reference 13) 
with P = (I - K_H) P 
n n n 


where P 1s the covariance matrix of estimation error 
after processing wae 

Q= 3” and it is the variance of random contact 
acceleration. The variance of contact acceleration must 
be equal and independent along x and y axis, and from scan 


to scan. 
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This form of the Discrete Kalman filter is valid for 
our contact maneuver problem. But the solution of the 
equations in matrix form 1s unnecessarily complex for the 
microcomputer. Therefore, an algebraic solution of each 
element in the matrix form of equations was formulated. 


These equations are listed in Appendix D. 


B. KALMAN FILTER PARAMETERS 
The Kalman Filter performance is determined by three 


Petamecers: 
2 


ij) op = Variance of the range measurement error 
2) o 4° - Variance of the bearing measurement error 
3) o 8° - Variance of the contact acceleration. 


The first two parameters are functions of the selected radar 
and the ship's gyrocompass. The third parameter is a 
function of the contact relative motion and the desired 
smoothness of the output data. 

In order to solve the tracking problem and figure out 
the parameters of the Discrete Kalman Filter, it is necessary 
to make measurements of 

a. Contact Range, 

fee Contact Bearing, 

c. Own Ship's Course, 

dad. Own Ship's Speed, and 


e. Time of the observation. 
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It is assumed that all noise iS Gaussian and Received 


Signal tO noise 
fhe minimum 
characteristics 


signal to noise 


ratios are large (>>l). 
performance of the selected radar (AN/SPS-10) 
are listed in Appendix C and the video 


ratio with single pulse detection is given 


as 
= Oc owe! 
7. 5 7 (Reference 8) 
(47) qT OF nen s® 
where 
Bok = peak transmitted power (Watts) 
G = antenna gain 
d = wavelength (m) 
O = radar cross section of contact (m7) 
01 = attenuation constant of propagation medium (dB/m) 
R = range to contact (m) 
k = Boltzman's constant aL ese 0 oe joule/deg) 
TS = standard temperature (280°K) 
= receiver noise bandwidth (Hz) 
Le = system losses. 


The contact range is determined by measuring the time 


required for a radar pulse to travel to and from the contact. 
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where c = speed of light 
t = elapsed time from pulse transmission to 
pulse detection 


io—efaamcge tO COnEaCt . 


Threshold detection could be used to indicate the 
occurrence of the leading edge of the received radar video 
pulse. Leading edge detection is selected because it 
eliminates errors resulting from variations in the pulse 
width. The standard deviation of range error is given 
below if the rise time of the pulse is limited by receiver 


bandwidth B. 


Oo = OO (Reference 8) 


The contact bearing is determined by measuring the 
bearing of the radar beam at the time the contact video 
is detected. Using beam splitting technique to estimate 
the center bearing of the contact, the standard deviation 


of bearing error is 


JA OS 


ys 
8 S lye 


Ne (a) = 
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¢, = Standard deviation of bearing error 

eS = two way beamwidth 

a = signal to noise ratio at center of beam 

‘ie = number of pulses emitted as the antenna rotates 
26. 


The standard deviation of range error and bearing error 
are functions of the video signal to noise ratio that 1s 
given on page 48 for a single pulse detection. When 
considering the threshold to noise ratio, it is necessary 
to define both the desired mean time between false alarms 
and minimum probability of detection of the contact. 
Probability of false alarms is given by Ref. 8 in terms of 
the mean time between false alarms and the IF bandwidth of 


the receiver as shown below. 


iL 


FA Tea Bor 


The mean time between false alarms is a function of 
the threshold to noise power ratio and the receiver IF 
bandwidth. And it can be increased if the tracking system 
is off whenever the contact is not in our selected range. 
The maximum unambiguous range of AN/SPS-10 Radar is 129.6 


Nautical miles and for example 50 nm of that is of our 
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concern. This would disable the measurement circuitry 
61.4 percent of the time and it will give us an additional 
advanatage. 

The mean time between false alarms of 35.3 sec (10 times 
the mean interval) has been selected. The probability of 


for one contact and 1.93x10°° for 


false alarms 5.66x10. 
50 nm of our interest range. And this leads to a threshold 
to noise power ratio of 12.5 dB. Also the reflected radar 
Signals from contact will fluctuate due to cancellation 

and reinforcement of the waves reflected from various 
positions of the contact. These fluctuations can be formed 
as Swerling's Case I and additional 11 to 14 dB will be 
required to insure a probability of 0.9 to 0.99 resepectively. 

The standard deviation for bearing and range can be 
related to contact range and cross sectional area as given 
in Ref. 9. Based on a threshold to noise ratio of 12.5 dB 
and interested range of a 50 nm the standard deviation 
of the radar range and bearing errors will be 140.2 yards 
and 0.2062 (0.003599 rad), respectively. 

In addition to radar measurement errors also there are 
ship's gyrocompass and pitometer log errors which come from 
the own ship's course and speed measurements. And gyro- 
compass not only determines own ship course but also deter- 
Mines the true bearing of the radar antenna. It is assumed 
that the standard deviation of own ship's gyrocompass 
error is 0.1 degrees (0.001745 rad) and standard deviation 


of own ship's pitometer log error is 0.1 knots. 
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Therefore, the variance of bearing error is equal to 
the sum of the radar bearing error (0.0425 deg’), and the 
variance of the own ship's gyrocompass error (0.01 deg?) 


leads to the total variance of bearing error 0.0525 deg? 


6 


or 15.998x1l0> rad’. The variance of range error 1S 


0.0048 nm*. 
The variance of target acceleration parameter is the 
ability of the filter to provide the closest estimate of 
a contact's position and velocity for a moving contact. 
It is good to allow the experienced operator to choose the 


variance of acceleration parameter to be used with each 


@entcact. 


C. KALMAN FILTER INITIAL CONDITIONS 

As it is explained before the Kalman Filter algorithms 
represent the recursive calculations of the optimal 
estimates of the covariance of estimation error matrix and 
the contact state matrix. The initial condition of the 
contact state matrix is equal to the expected value of the 
initial state. The expected values of the initial position 


elements are the first measurements: 


x = R(0) sin 6(0) 


KK 
il 


R(0) cos 6(0) 


The expected values of the initial velocity elements are 


pero. 


3) 





The initial condition of the covariance of estimation 
error matrix is equal to the covariance of error of the 


initial state estimate: 


P(0) = ElZ) - 2Z(0)](2(0) - Z(0)]” 
> 
E[(X,~-X9) 0 0) 0 
0 EL(X,)* 0 0 
P(0) = _ 2 
0 0 E((Y_-¥ 5) ] e 
am 
0 0 E[Y,) ] 


The time required for the Kalman Filter to achieve 
a steady-state condition is very sensitive choosing the 
closest right values of the nonzero elements of the initial 
state estimate matrix. They were chosen to be brought the 
contact On y-axis as an initially by given equations in 


Reference 13. 
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Me 6 OOYSTEM DESCRIPTION 


The description of the system is divided into three 
major areas: hardware dependencies, system characteristics, 


and system performance. 


A. HARDWARE DEPENDENCIES 

Because of hardware equipment that was selected the 
following hardware dependencies exist in the current 
implementation of the system: 

1. The system utilizes an SBC-310 High-Speed Mathematics 
Bare tO perform floating point arithmetic. Although as 
discussed before the presence of this math unit could be 
avoided by replacing its functions with appropriate software 
routines performing the same operations using the same 
formats, this is not recommended because of excessive over- 
head that would result, especially with regard to the 
execution time. Appendix F explains how the Math Unit was 
actually implemented. 

2. The system depends in three ways on the type of 
terminal used. The serial asynchronous procedure necessary 
to communicate between CPU and the terminal, the code needed 
Semeeonctrol the CRT's functions, and the general features 
Of the DATAMEDIA Elite 2500 Video Terminal notably the 
programmable roll mode, the setting of privileged fields, 
the capability of having an addressable cursor, and the 


possibility of making displayed messages blink. 


54 





3. The system occupies approximately 13K bytes of 
physical memory for code, and approximately 3K bytes to 
be used for variable data, therefore a configuration of 
at least 16K bytes of RAM is necessary to execute the 


system. 


Pees YolLeM CHARACTERISTICS 

As it was established before, the system was designed 
to perform basically to solve the maneuvering board problem 
finding the contact speed and course. 

Due to interaction capability between modules as 
allowed by the language PL/M-80 through the use of attri- 
butes PUBLIC and EXTERNAL for the procedures, the following 
list was written in order to show interactions. This list 
shows the modules which have procedures called by the’ 
listed module. 

im EXTER 

2. INTSDATA 

3. MAINSPROG 

4. DISPLAY 

a. NUMOUT 

b. DISPLAYSCRT 
c. CRTSREAD 

a. ©HECKSYESSNO 


e. DISPSERROR 
5. FLOATINGSPOINT 


a. MUL 
pe .~DIV 
eS. Bory 
ad. FMUL 
e. FDIV 
ff. FADD 
ore tees. Of) 
h. FSOR 
i. FLTDS 
j. FIXSD 
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Keer oORT 
1. FCMPR 
ee lah Ad Se 
n. COSSSIN 
Oo. ARCSTAN 

The Module "INTSDATA" is used to implement the radar 
measurements: range as a yard, bearing as a degree, time 
of measurements as a second and their interfaces process 
the system. 

The "MAINSPROG" Module used to perform the Kalman filter 
algorithms, computation of the filtered target course and 
speed, display of the result and error performance. 

The Module "DISPLAY" includes: |lthe display procedures 
on the CRT 

The "FLOATINGSPOINT" Module is used to perform the 


floating point arithmetic. 


In order to achieve these objectives, a bottom-up 
implementation philosophy was chosen. Because of the 
modular design encouraged by PL/M 80 and ISIS-II, it was 
also possible to map the different levels of design into 
corresponding modules of software. The basic idea was to 
encompass all functions corresponding to a level of design 
into one software module capable of performing all the 


necessary functions. 


C. SYSTEM PERFORMANCE 
The performance of the Kalman filter was evaluated for 


maneuvering contact. The own ship was proceeding on a 
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steady course (000°) North and at a fixed speed of 30 knots 
from an initial position at the origin of the cartesian 
coordinate system as shown in Chapter II, Figure 3. The 
contact was heading to 060° true (North/East) by 36 knots 
and its initial position was 009.6° (North/East), 37,800 
years from own ship. 

The scenario has been made to change the contact 
course and speed after every 15 sets of measurements. The 
approximate problem was solved on the maneuvering board and 
by hand calculator. The first chance has been made for 
contact course and speed which were 073° (North/South) true 
and 50 knots, respectively, then second reorientation has 
been made to 328° (North/West) true course and 30 knots 
speed. 

The accuracy of the computed course and speed of the 
contact will depend on the tracking system parameters and 
the maneuverability of the contact. The antenna rotation 
rate determines the mean time between measurements, which 
in the case of the AS-1161/SPS Antenna equates to 3.53 
seconds. The majority of surface contacts will be capable 
Se turning radii of 100-1000 yards, velocities of 0-50 


knots, and acceleration of 0-0.5 yards/sec’. The following 


2 


and o 2) were 
8 1@ 


Kalman Filter measurement parameters (a 


used as calculated in Chapter IV, Section B. 


2 0.0048 nm* 


Q 
ll 


6 2 


15.988xl0 ~ rad~ . 


Q 
ll 
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The Kalman filter initial conditions were the same as 
those discussed in Chapter IV, Section C. The variance 


of contact acceleration (0°) parameter was selected as 
os * = 0.0004 nm*/sec* 


Also as is mentioned before, the variance of contact 
acceleration (0,7) parameter is an independent variable and 
it is a compromise between the user's desired smoothness 

of the output data and the ability of the filter to provide 
the closest estimate of a contact's position and velocity. 

This parameter could be selected by enabling one of 
several read-only memories (ROM) containing the desired 
values. The particular ROM installed at any. one time .could 
be selected from a library of such ROM's by the Commanding 
Officer, depending on the ship's mission. 

The filtered outputs of the contact course and speed 
according to the selected scenario were plotted on Figure 8 
and Fiture 9, respectively. As is noted on those figures, 
the Kalman Filter achieved a steady state condition after 
four to seven contact position measurements, corresponding 
to 14.1 and 24.7 seconds related to the amount of reorienta- 
tion has been made on contact course and speed. Steady state 
is defined as the condition where the Kalman Filter Gain 
Matrix (K) would be constant for contact with constant 


relative position and constant sample intervals. 
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The bearing, range, course, and speed of contact was 
computed from the Kalman filter's optimal estimate of 
contact state and compared with the actual contact bearing, 
range, course and speed. Figures 10, 11, 12, and 13 show 
plots of the filtered output of the contact bearing, range, 
course and speed errors, respectively, as a function of 
the time interval between measurements. 

Several conclusions can be made from these figures. 
First of all the Kalman filter initial conditions are 
very much affected on bringing the Kalman filter to steady 
state condition. Any information about contact speed would 
cause to shorten the time spent achieving a steady state 
condition. Also selecting the variance of target accelera- 
tion parameter is as important as initiating the filter. 
The value of the variance acceleration parameter 0.0004 
sec” were chosen after many trials of that selected 
scenario. It should be noted that the error averages for 
contact are a function of the elapsed time between maneuvers 


and the time spent in maneuver. 
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VI. CONCLUSION 


A microcomputer-based tracking system has been developed 
that eliminates an inaccurate and tedious task of manual 
tracking, for any ship, without the expense of NTOS size 
2quipments, with digital automatic surface/subsurface capa- 
Sa lity. 

It is possible to obtain optimal estimates of contact 
90Sition and velocity, with the aid of the 4-state Discrete 
Kalman Filter and appropriate conversions for polar coordinate 
neasurements. Thus the contact course and speed computations 
vere successfully performed by using the Intel intellec MOS 
nicrocomputer system, much more accurately than manual 
tracking techniques. 

The SBC-310 High Speed Mathematics Unit has been selected 
sased on a standard floating-point number format with 24 
>it mantissa, 7 bit exponent and a Sign bit by comparing 
=xecution times of procedures to perform sufficient accuracy 
to reliably compute the Kalman Filter Algorithms and con- 
version factors. 

The total average of the system execution time was 
approximately 50 msec and with the 3.5 sec sweep of an AS- 
1161/SPS radar antenna, a single system could continuously 
provide bearing, range, course and speed data for more than 


Fifty contacts by modifying the software program. 
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For future work it is possible that the system could 
compute a contact's closest point of approach (CPA) and could 
display as (1) CPA Bearing, (2) CPA Range, and (3) Time of 
CPA by a more sophisticated software study. 

The system can be a valuable tool aboard non-NTOS ships 
as implemented. A microprocessor-based system such as the 
one described, has the potential to provide any ship with a 
digital surface/subsurface tracking capability without the 
expense of NTOS size equipment. It can reduce the manning 
of underway watches while improving the quality of the 


tactical information available to the Officer of the Deck. 
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APPENDIX A 
Intel SBC-310 High Speed 
Mathematical Unit Descriptions 

A. GENERAL INFORMATION 

The floating-point package developed for this system is 
based on the SBC-310 High-Speed Mathematics Unit fromIntel 
Corporation. As described by Reference 1, the SBC 310 Unit 
is a member of a complete line of the Intel SBC 80 System 
expansion modules. In performing high-speed mathematical 
functions, the Math Unit acts as an intelligent processor 
slaved to one or more SBC 80 Computer Masters. The Mathe- 
matic Unit performs its repertoire of 14 arithmetic functions 
an order of magnitude faster than is possible with software 


foutines. 


B. DESCRIPTION OF THE MATH UNIT 

The Math Unit is a microprogrammed processor on a single 
board and is designed to be plugged into a standard SBC 
604/614 Modular Backplane and cascade to interface directly 
with an SBC 80 single board computer or to be used with an 
Intel Intellec Microcomputer Development System (MDS). 

The Math Unit includes the following standart Intel Series 
300 shotthy bipolar components: 3001 Microprogram Control 
Unit (MCU), 3002 Central Processing Element (CPE), 3003 Look- 
Ahead Carry generator (LCG), and 3604 Electrically Programmable 


Read Only Memory (PROM). Also included are pipe line register 
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and bus interface logic. The pipeline register permits the 
overlapping of microinstruction fetch/execute cycles and the 
bus interface logic provides compatibility Les the Intel 
Multibus. 

Standard Operations include Eloating point add, subtract, 
multiply, divide square and square root; fixed point integer 
multiply, divide, and extended divide; conversion between 
fixed and floating point representations; and test, compare, 
and argument exchange operations. 

The Math Unit implements unbiased rounding for maximum 
accuracy. Unbiased rounding is the same as ordinary rounding 
unless the result is exactly midway between two floating 
point numbers; in this case ordinary rounding always increases 
the result, whereas unbiased rounding rounds the result to 
the nearest even number. When a calculation is performed 
that results in either an exponent underflow or overflow, the 
Math Unit provides exponent wraparound to prevent loss of 
information. 

Operation Codes for invoking the arithmetic functions are 
passed to the Math Unit via I/O Write, Commands, which are 
also used to initialize the unit with a memory base address. 
I/O read commands are used to determine the math unit status. 
Arguments are passed to the Math Unit via Memory Write, 
Commands and the results are obtained via Memory Read Commands. 

The Math Unit which can be operated either in the Inter- 


rupt of Polled mode, generates a busy signal during processing 
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operations and generates either a complete signal or an Error 
signal after the computation is complete. The information 

to the host computer which these three signals convey is 
explained in Ref. (1). 

The memory base address and I/O base address are user 
selectable. The 16-bit memory address is completely under 
software control and 1S asSigned by the host processor through 
a sequence of I/O Write Commands, addressed to the Math Unit. 
The 8 bit I/O base address is selected by a dual inline 
package (DIP) switch on the board. 

All Math Unit operations including arithmetic calculations, 
data flow between functional elements on the board bus inter- 
face, and associated logical tasks, are resident microprogram 
permanently stored in a set of eight Intel 3604 Erasable 
Programmable Read Only Memory (EPROM) chips. This menote 


provides 1,024 micro-instructions of 32 bits each. 


C. PREPARTION FOR USE 
1. Installation Consideration 

The Math Unit is designed for interface with an Intel 
SBC 80 single board computer based system or an Intel Intellec 
Microcomputer Development System (MDS). 

When installing the SBC 310 in an Intel Intellec MDS, 
the CPU board needs to be reconfigured in order to generate 
@a Qualified Write Signal; this reconfiguration was obtained 
by considering the advanced acknowledge (AACK) feature by 


moving a jumper labelled "advanced write" from a D-C connection 
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to an E-D connection and by disabling the AACK/LINE (pin 25) 
9n the CPU board as shown in the schematic diagram on page 
3-47 of Reference 4. 
2. I/O Base Address Switches 

The host processor transmits control information 
and receives status information from the Math Unit by issuing 
[/O Write and I/O Read Commands, respectively. The I/O 
address used for these commands is relative to an 8~bit base 
address that must be a multiple of 8. This base address is 
assigned by the user by means of an 8-pole dual inline package 
(DIP) switch assembly. Five of the eight switch poles are 
connected to the I/O base address detection logic; the other 
shree poles are unused. 

The Math Unit had used its DIP switch set to the 
[/O base address of 10 hexadecimal (only switch pole no. 4 
vas set on). 

3. Programming Information 

The I/O base address, which must be assigned by switch 
selection before the memory base address can be assigned, is 
10rmally performed as part of the initial installation proce- 
jure. This switch setting allows the user to establish a 
reference or base to the ports being used in the I/O opera- 
tions; Table 7 shows the configuration of the I/O addressing 
aS it was set in the system. 

The memory base address, which is software controlled, 


lS assigned by a sequence of two I/O Write Commands. The 


yal 








I/O PORT 
ADDRESS ONGdig AO Neo 


a 
paso [ewe 
Se 
a 
snow [| 
cE 
feo fe 


I/O BASE ADDRESS 
RESERVED 
CODE: MATHEMATIC FUNCTION; See Table 4 


FLAG BYTE 


MEM. LOW: Memory BASF ADDRESS (Lower Byte) 
MEM. HIGH: Memory BASE ADDRESS (Upper Byte) 





Table 7. I/O ADDRESSING OF SBC-310 HIGH SPEED MATH UNIT 
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an ———————— ——— ine 


first command is addressed to port (P+l) and loads the low 
order byte of the memory base address. The second command is 
addressed to port (P+2) and loads the high order byte of the 
memory base address. The memory base address must be a 
multiple of 16; i.e., the lower byte must be in the form XOH 
(X is any hexadecimal digit) to accommodate the 16 required 
memory locations used in the arithmetic operations. In the 
system developed for this thesis the memory base address was 
set of OF790H. After both bytes are output, the memory base 
address (M) is established and need not be reloaded during 
any subsequent operations. An initialization routine for 
establishing the memory base address was designed and it can 
be seen in the "INITSFP" procedure in the floating point 
module (see "FLOATINGSPINT"™ module in Appendix F). 
4. Math Unit Functions 

The Math Unit performs floating point arithmetic, 
fixed-point integer arithmetic, compare and test operations, 
and, float-to-fix and fix-to-float conversions. Operation 
Codes and execution times for the various functions are 
listed in Table 4. Arithmetic and conversion formats are 
shown in Table 8. 

Beyond the functions performed by the Math Unit, 
the floating-point package was designed with two more proce- 
dures which compute the cosine and sine of a given angle and 


the arctangent value of the ratio of given arguments. 
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SINGLE PRECISION FLOATING POINT 

















sign binary point eee 


ZEROES 


~exponent 
8 bits 





where: M: Memory Base Address 
S: "0" = positive; "1" = negative 


E7-E0: Biased exponent; Bias = O7FH. 
F22-FO: Fraction; F is always normalized 


binary point 
where: M: Memory Base Address 


F15-FO: 16-bit integer (unsigned) 


where: M: Memory Base Address 
F31-FO: 32-bit integer (unsigned) 


where: M: Memory Base Address 
S: "OQ" = positive; "1" = negative 


F30-FO: two's complement integer 





Table 8. ARITHMETIC AND CONVERSION FORMATS FOR 
SBC-10 HIGH SPEED MATH UNIT 
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5. Argument and Result Data Formats 

Argument and result data formats and memory locations 
for the various operations are presented in Table 9. For each 
argument and result, this table includes a Format number 
cross-referenced to one of the four formats shown in Table 8. 
Table 9 also includes the OP CODE for each operation. It is 
important to note that the result of an operation replaces 
the first argument in memory, and that the second argument 
may be destroyed in the course of the computation, these 
side effects were avoided in the floating-point software 
design by saving the original values and by allowing the 
user the possibility of having one of the operands as the 
result. Error conditions for each operation are described 
in the next paragraph. 

6. Status and Flags 

The Math Unit may be operated in the interrupt mode 
or plled mode. 

In the interrupt mode, the Math Unit may be wire- 
wrapped to initiate an interrupt request under one or both 
of the following conditions: 

a. Operation Complete without an error. 

b. Operation Complete with an error. 

These “completion” signals may be individually wire- 
wrapped to separate interrupt lines or both "completion" 
Signals may be wire-wrapped to the same interrupt line (Reference 


1). 


iS 





ARGUMENT “ 








M,M+1 2 
MH M45 
M,Mtl,M+2,M+3 
epiv | & am =a 2 Mrs 2 haz Aides Gn ye 
4 M+5 ,M+6 ,M+7) 

FMUL 2 1 M,M+tl ,M+2,M+3 1 M,M+1 ,M+2,M+3 
...., i M4, M45 ,M+6 MET 
FADD 4 
FSUB 5 
FSOR 6 1 M,M+1 ,M+2,M+3 


M M+1,M+2 ,M+3 
FSORT 


Sn rere 
ros [> [| woman 


M,M+1 ,M+2,M+3 


M+4 ,M+5 ,M+6,M+7 
*Refer to appropriate FORMAT No colum in Table 8 


**Second argument is always the operator, and may be destroyed 
during Operation. 


***Results of all operations, except FIXSD are rounded, FIXSD 
truncates the result. 













Table 9. OPERATION ARGUMENT AND RESULT DATA FORMATS FOR 
SEBEG=10 
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In the polled mode, the subroutine designed fo rthis 
purpose checks both the status byte and the flag byte (Tables 
10 and 11). The polled mode procedure loops on testing the 
busy bit until the busy bit is clear and then checks the 
error bits. If an error exists, the error code is input from 
the Math Unit and a message error 1S issued. The software 
has developed for control of the Math Unit if the system 
employs the polled mode described. 

As mentioned before, the condition of the Math Unit 
is continuously updated and stored. The flag byte shown in 
Table 10 may be obtained by performing an I/O Read Command 
to Pt 7 (Table 7). After an operation is completed, the 
Status byte may be obtained by performing an I/O Read Command 
mo P+tL (Table 7). 

As shown in Table (11), the status byte indicates 
error conditions where applicable and the results of compare 
(FCMPR procedure) and Test (FZTST procedure) operations. 

Each of the six error conditions are defined as follows; 

a. Divide by Zero: (001) 

This error condition is returned by either "DIV", 
"EDIV", or “FDIV" procedures to indicate that an attempt was 
made to divide by zero. 

6b. Domain Error (010) 

This error condition is returned by the "FSQRT" 
procedure to indicate that the argument was not in the domain 
of the function; i.e., an attempt was made to take the square 


root of a negative number. 
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7 6 5 4 3 2 I 0 
e{rfetrial ete jo 
1s reserved for future use 
1s busy 


1S Operation complete without error 
1S operation complete with error 


a 
when B = 1, the Math Unit is busy and can not 


respond to further request except request for 
flags. 





Table 10. FLAG BYTE FORMAT FOR SBC-310 
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@) 


7 6 5 4 3 2 i 
=fof<fatef ae 


where; 


R is reserved for future use 

= is equal (for FCMPR and FZTST) 

> 1s greater than (for FCMPR and FZTST) 
< is less than (for FCMPR and FZTST) 


ERR is a 3-bit error code specifying one of 
the following error conditions, 


Q0Q0 No error 

001 Divide by Zero 

010 Domain Error 

Q11 Over flow 

100 Under flow 

101 First argument invalid 
110 Second argument invalid 
lll Reserved 


faele ll. STATUS BYTE FORMAT FOR SBC-310 


is 





c. Overflow (011) 

This error condition is returned by the "FADD", 
meee, FMIL", “FDIV", "FSOR", and "FIXSD" procedures. In 
the case of "FIXSD" procedure, this error indicates that the 
floating-point number is too large to be converted to a 32 
bit two's complement signed integer. If an overflow error 
occurs during "FIXSD", the floating-point argument is left 
unchaged and may be read from the Math Unit. 

In all other cases, this error condition signifies 
that the exponent of the result is too large to be repre- 
sented in eight bits. In this case, OBEH is subtracted from 
the resulting exponent (bringing it back into range for other 
computations and ensuring a valid result), and the lower 
eight bits of the exponent are returned in the exponent field 
of the result. 

a. Underflow (100) 

This error condition is returned by "FAOO", 
eBoUB", "PMUL", "FDIV", and "FSOR" procedures to indicate 
that the exponent of the result is too small to be represented 
in eight bits. In this case OBEH is added to the resulting 
exponent bring it back into range for other computations and 
ensuring a valid result, and the lower eight bits of the 
@eeement are returned in the exponent field of the result. 

e. First Argument Invalid (101) 

This error condition is returned by the “FADD", 

foes, FMUL", "“FDIV", “FSOR", "FSQORT", “FIXSD", "FCMPR", 


and "FZTST" procedures to indicate that the first (or only) 
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argument for the specified function is invalid. The second 
argument (if applicable) is not checked if this error is 
encountered. The invalid argument is left unchanged and 
may be read from the Math Unit. 
f. Second Argument aerate! (110) 

This error condition is returned by the "FDD", 
"FSUB", "FMUL", "FDIV" and "FCMPR" procedures to indicate 
that the second argument for the specified function is 
invalid. This error condition occurs only after the first 
argument is checked and found valid. The invalid argument 
is left unchanged and may be read from the Math Unit. 

Notes: 

(1) The floating-point argument may be expressed 


as: 
E 
Ge x (25 =" BIAS)"x (1.F) 
Notice that a "1" is assumed in the highest position of 


meaction. 


(2) There is one unigue representation for zero; 


S = Q 
Pos. = 0 
R228 20 =~ 0 
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(3) The following representations are invalid. 


(a) Assures unique representation of zero 


(b) Reserved for future enhancements 


feeeexamples of Floating-Point Number. Representations 


As shown in Table 8 the representation of a floating- 
point number has one particularity that needs to be men- 
tioned; i.e., a "1" is always assumed in the highest bit 
position, and then it yields an effective 24-bit mantissa. 


For the sake of clarity some examples are given in Table 12. 
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F.P. Number 


SPP INITY 


2s>.0 


= 5.0 


+ 255.0 


=o 


INFINITY 


ex 


1.07x107 *** 


* 
This is the largest number in the single-precision 
mPhoating=—point format. 


** This is the smallest positive number in the single 
precision floating-point format. 


*ek* This is the largest number that can be converted 
to floating point without loSing accuracy. 


Table 12, 


FLOATING POINT NUMBERS 
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APPENDIX B 
System Start-Up Procedure 
Caution: Never turn on or off the diskette drive with 
a diskette inserted !!! 
TURN ON MDS SYSTEM. Use the key located at the upper 
left corner of the front panel and turn it clockwise. 
The power indicator should light. 
TURN ON DISKETTE DRIVE. Use power switch located at the 
front panel. The on indicator should light. 
TURN ON DATAMEDIA TERMINAL (CRT). Use switch located 
on right side. The cursor should appear at the screen 
after a few seconds. Ensure that the lights CD, CTS, 
ROLL and FULL DUPALLEX are on. 
PLACE SYSTEM DISKETTE IN DIRVE 0O and the source diskette 
in drive l, with the read/write access slot first. Close 
door of the drives after insertion. 
BOOTSTRAP THE ISIS~-II OPERATING SYSTEM. 
a. Press top of the Intellec BODY Switch. 
b. Press top of the RESET Switch. 
c. Observe that INTERRUPT 2 INDICATOR goes on before 
proceding. 
d. Press space-bar of Datamedia video terminal keyboard. 
e. Observe that INTERRUPT 2 indicator goes off before 
proceding. 


f. Press bottom of BOOT Switch. 
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g. Observe that the following message appears at the 


Datamedia Video terminal screen; 
IES IES Sibley WES 
Issue the following Command; 
Sete ra DL 


After a few seconds, the Datamedia Video terminal screen 


will show the first computation of COURSE, BEARING, 


RANGE, SPEED, THE KALMAN FILTER GAIN MATRIX ELEMENTS, AXxX, 


fee, AYX, AYY, BXX, BXT, BTX, BYY and the FILTER Error 
Performance DELTA RANGE, DELTA BEARING, DELTA RANGE DOT, 
DELTA BEARING DOT and following message appears at the 


screen: 
NEXT ? (Y/N) 


PRESS THE LETTER 'Y‘ and see ‘YES" message appear on the 


screen to compute next measurement. 
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APPENDIX C 


AN/SPS-10 Search Radar Characteristics 
with AS-1161/SPS Radar Antenna 


Peak Power, 

Antenna Gain, 

Pulse Repetition Rate 
Frequency 

Propagation Attenuation 
Noise Figure 

Band width 

Noise Bandwidth 

System tosses 

Antenna Rotation Rate 


Antenna Horizontal Beamwidth 
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190 KW 
OCs 
625 Hz 
5825 MHz 
0.6 x 10 
2209 a5 
5 MHz 
(1.05 x B) 
eae 
17 rpm 
LOS Ja 


5 


aB/m 


~~ 
~~. 
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APPENDIX D 


Algebraic Form of Discrete Kalman Filter 


lL. COVARIANCE MATRIX FOR THE OBSERVATION NOISE 


0° (n) Oy (n) 
R = 
n 
2 2 
Pry (n) oy (n) 
0° (n) = 0° ° shar Oe - A nh “of . SoC 
0 (n) = of . eae R hat + he) : of . Seer 
os, (Mm) = > - sin 26(n) - [o- = me (n) oo] 


2. THE GAIN MATRIX 


iS I 


K = P (n) SoH -(H*P(n)*H2 : R) 


b = (Pyy(n) +02 (n)) (P33 (m) + 09 (n)) 


™~e 


2 e 2 
(P31 (n) + of, (n)) (Py3(n) + a(n) 


~ 


x 2 i ~ 2 
A (n) = [P, (n) (P,, (n) +o, (n))-P, 4 (nm) (P,, (n) to, (mn) IZA 
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Apy(n) = (Py3(n) (Py, (n) +04 (n)) - Py, (n) (P,, (nm) +05, (n)) 1/0 


ae 


Avg (BA) = [P3, (n) (P33 (n) +05 (n)) ~ P33 (n) (P53 (n) +04, (n)) 1/0 
A,y(n) = [P33 (n) (Pyq(n) +04 (n)) ~ P53 (n) (Py 3 (n) +04, (n)) 1/0 
Buy (N)/T = [P54 (n) (P33 (n) +00 (n))-P2, (n) (P3, (n) +04, (n)) 1/0 
Bay (n)/T = [Py3(n) (Pyq (n) +04 (n) =P, (n) (Py 3 (n) +04, (n) 1/8 
By, (n)/T = (Pg (n) (P33 (n) +05 (n))-P4 (n) (Py (n) +04, (n) 1/0 

Boy n)/T = [P43 (n) (Py y(n) +04 (n)) =P, (m) (Py 3 (n) +05, (n) 1/4 


3. THE COVARIANCE MATRIX OF ESTIMATION ERROR AFTER 
PROCESSING THE OBSERVATION 


Po = (I-KH) PL 
Pia (m) = Paylin) (1-A,,) - P3y(m) ALY 
Py2 (n) 7 P12 (n) (1 -A,) i P32 (n) Any 
Pj,(n) = P,4(n)(1-A,.) - P43 (n) Any 
P, 4 (n) - Py 4 (n) (l1-A,.) = P,,(n) AL 
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A. 


THE COVARIANCE MATRIX OF THE ESTIMATION ERRORS 
PRIOR TO PROCESSING THE OBSERVATION 


Pj, (ntl) = Piz fn) + (P,, (n) +P), (n))T+P5,5(n)T + ost J4 
p (n+l) = P (n) + P (n)T + 20/2 
iil = AT Ae, Ca 
~ = A A “A A 2 
P,3 (ntl) = P53 (n) + (P,,(n) +P,,(n))T + Po, (n)T 
Pyg(mtl) = Pyyln) + Po,tn)T 
BMingl) = P..(n) + P..(n)T + o-°T?/2 
pa +? feo 22) wae 
a a) Wa Deo 
Po, (ntl) - Po, (n) 5 ano ee & 
Pog(ntl) = Po3(n) + Poyg(n)T 
Po, (ntl) = Po, (n) 
“aad mn mn ay ay 2 
P,, (ntl) = P., (n) + (P,,(n) +P,,(n))T + Pio (n)Tt 
P45 (ntl) = P44 (n) + Pag (n)T 
P..(ntl) = P..(n)+(P..(n)+P.. (n))THP.. (n)T*+0°T 4/4 
Bo a 3 Me 4 St 44 ‘7 Ca 
p (n+l) = p (n) + p Chet a o* nt /2 
34 34 44 a 


on 





“A “”~ 


Py, fa) oa Pag (n)T 
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